關(guān)鍵詞：家庭服務(wù)機(jī)器人；自主導(dǎo)航；勢場柵格法；滾動路徑規(guī)劃；室內(nèi)移動 中圖分類號：TP242．6 文獻(xiàn)標(biāo)識碼：A Research on Autonomous Navigation and Path Planning of a Home Service Robot CHEN Hao, XIAO Nan-feng, QI De-yu (Computer School, South China University of Technology, Guangzhou 510641, China) Abstract: The ordinary industry robot seems to be incapable for the home services. The people are expecting a home service robot to complete the home service work. Therefore, we develop the home service robot. This paper presents a new approach for the autonomous navigation of the home service robot with the combination of describing environment based on grids and path planning based on potential field as well as rolling windows. Multi- channel sonar array and infrared ray finders are used to obtain the environment information. Simulation results confirm that the present approach is correct and effective. Key words: Home robot ; Autonomous navigation; Potential grid method; Rolling path planning 1 引言 近年來，隨著智能機(jī)器人技術(shù)的迅速發(fā)展，智能機(jī)器人的應(yīng)用領(lǐng)域正在不斷地擴(kuò)大，智能機(jī)器人已經(jīng)開始進(jìn)入了家庭服務(wù)行業(yè)[1]。由智能型家庭服務(wù)機(jī)器人代替人來完成各種家務(wù)勞動，這不僅是一項極具應(yīng)用前景的高新技術(shù)行業(yè)，而且也已是智能機(jī)器人目前研究的一個重要熱點。為此，我們開發(fā)了一個能在室內(nèi)的家庭環(huán)境下自主移動和工作的家庭服務(wù)機(jī)器人，它主要有10大功能：(1)防盜監(jiān)測；(2)安全檢查；(3)家電控制；(4)清潔衛(wèi)生；(5)物品搬運(yùn)；(6)家庭娛樂；(7)病況監(jiān)視；(8)兒童教育；(9)報時催醒；(10)電話接聽。并且它可通過互聯(lián)網(wǎng)和手機(jī)進(jìn)行遠(yuǎn)程控制，見圖1所示。 家庭服務(wù)機(jī)器人作為一種室內(nèi)移動機(jī)器人，在自主導(dǎo)航過程中，它常常面臨著無法預(yù)知和不可預(yù)測的動態(tài)環(huán)境，而且它感知環(huán)境的傳感器給出的數(shù)據(jù)是固有的、不可避免、不完整、不可靠、不精確的[2]。因此，解決自主導(dǎo)航是一項十分艱巨的任務(wù)。目前，在已知的環(huán)境下，研究移動機(jī)器人對靜態(tài)障礙物的路徑規(guī)劃已經(jīng)取得了豐碩的成果?，F(xiàn)在人們更多地開始注意動態(tài)環(huán)境下或不確定環(huán)境下的路徑規(guī)劃問題。本文主要研究家庭服務(wù)機(jī)器人在家庭居室環(huán)境下自主導(dǎo)航與路徑規(guī)劃問題。 圖1 家庭服務(wù)機(jī)器人 2 家庭服務(wù)機(jī)器人自主導(dǎo)航 2．1 工作環(huán)境 家庭服務(wù)機(jī)器人最常見的工作環(huán)境是結(jié)構(gòu)化環(huán)境，這些場所的共同特征是比較規(guī)范[1]。在這種環(huán)境中，機(jī)器人和人經(jīng)常要發(fā)生互動作用，例如來來回回走動的人等。然而，家庭服務(wù)機(jī)器人必須使自己行走于各種物體之間，而不出現(xiàn)碰撞。家庭服務(wù)機(jī)器人主要工作于家庭居室環(huán)境中，因此對障礙物的描述有很好的便利，應(yīng)用柵格法對家庭服務(wù)機(jī)器人導(dǎo)航地圖進(jìn)行處理也有很好的效率。 2．2 自主導(dǎo)航系統(tǒng) 家庭服務(wù)機(jī)器人自主導(dǎo)航原理如圖2所示。本項研究中的導(dǎo)航系統(tǒng)配備了1個CCD攝像機(jī)、15個超聲波傳感器、14個紅外線傳感器、2個光電編碼器用于自主導(dǎo)航。 3 家庭服務(wù)機(jī)器人運(yùn)動學(xué) 3．1 運(yùn)動學(xué)模型 建立運(yùn)動學(xué)模型是進(jìn)行路徑規(guī)劃和路徑跟蹤的前提。本項研究所采用的是兩輪差速驅(qū)動方式。運(yùn)動示意圖如圖3所示。其中，XOY為世界坐標(biāo)系(地圖坐標(biāo)系)，xoy為它本身的坐標(biāo)系，家庭服務(wù)機(jī)器人的運(yùn)動學(xué)方程式為： 轉(zhuǎn)速，r表示輪子的半徑。 3．2 航位推算 目前機(jī)器人定位系統(tǒng)主要有相對定位和絕對定位系統(tǒng)[3]。本項研究采用相對定位系統(tǒng)，這種定位的最大優(yōu)點是系統(tǒng)簡單和成本較低，適合于家庭服務(wù)機(jī)器人。機(jī)器人通過2個光電編碼器可以較準(zhǔn)確的知道自身行走的距離和轉(zhuǎn)彎角度。在推算航位時，根據(jù)左、右光電編碼器的輸出值可以求得家庭服務(wù)機(jī)器人控制系統(tǒng)第n次采樣時左輪子位移Dl 結(jié)合運(yùn)動學(xué)方程式(1)，可以得到航位推算算法如下： 4 家庭服務(wù)機(jī)器人路徑規(guī)劃 4．1 勢場法與柵格法 文獻(xiàn)[4]綜合了勢場法和柵格法的優(yōu)點，提出了勢場柵格法。本項研究亦采用勢場柵格法，并結(jié)合滾動路徑規(guī)劃原理對未知或運(yùn)動障礙物進(jìn)行路徑規(guī)劃。用勢場法進(jìn)行路徑規(guī)劃，要求障礙物最好是規(guī)則的。而用柵格表示地圖，能夠很好地處理障礙物邊界問題，避免復(fù)雜的計算。但柵格法存在存儲量大和計算量大等問題，限制了它的使用范圍。所以將柵格法與勢場法結(jié)合起來將會是一種高效的算法。 與文獻(xiàn)[4]不同的是，本項研究不采用啟發(fā)函數(shù)，而是用柵格來表示地圖。非障礙物所在的柵格置為0，其它柵格置為0。然后利用人工勢場法計算機(jī)器人所在柵格中心點的勢場函數(shù)值，判斷運(yùn)動方向，由此決定移動的下一個柵格，并循環(huán)整個過程，直到到達(dá)目標(biāo)為止。在柵格地圖中，很容易掃描到最近的障礙物柵格，比普通人工勢場法障礙物的尋找方便很多。在柵格地圖中，運(yùn)動方向共有八個，如圖4所示。 大小。此算法的特點是：(1)應(yīng)用柵格法計算地圖中人工勢場函數(shù)時，只要計算當(dāng)前柵格的函數(shù)值，避免了傳統(tǒng)勢場法的大計算量問題；(2)采用了修正勢場函數(shù)，從而避免了局部最優(yōu)點問題。 4．2 勢場函數(shù)構(gòu)造 人工勢場可以想像為在運(yùn)動過程中，目標(biāo)柵格產(chǎn)生的引力場與障礙物產(chǎn)生的斥力場相疊加后產(chǎn) 4．3 路徑節(jié)點搜索 路徑節(jié)點的探索是在柵格地圖中進(jìn)行搜索相鄰節(jié)點。按照式(6)～(13)計算出該柵格點所對應(yīng) 在算法的具體實現(xiàn)中，柵格需要在三種情況下打上標(biāo)記：①當(dāng)從柵格n進(jìn)入到n+1后，再選的不是n+2，而是回到n。為了防止路徑點的循環(huán)與交叉，要為經(jīng)過的柵格打上一個標(biāo)記；②從柵格n進(jìn)入到柵格n+1時，可能會出現(xiàn)柵格n+1是個死胡同，或者是已經(jīng)走過的路徑，則要返回到柵格n，并為柵格n+1打上一個標(biāo)記。③邊緣情況，也就是地圖最外圍的柵格，這些柵格的八個方向有些方向是不存在的，要給其打上標(biāo)記。在路徑規(guī)劃過程中，如果所找到的柵格是上述打過標(biāo)記的柵格或是障礙物柵格，則要忽略它。按由上面三種標(biāo)記和改進(jìn)的人工勢場法就可以克服勢場法存在的4個主要缺陷：(1)存在陷阱區(qū)域；(2)在相近障礙物間不能發(fā)現(xiàn)路徑；(3)在障礙物前震蕩；(4)在狹窄通道中擺動。 4．4 滾動路徑規(guī)劃 文獻(xiàn)[6]中借鑒了預(yù)測控制滾動優(yōu)化原理，提出了基于滾動窗口的移動機(jī)器人路徑規(guī)劃方法。滾動路徑規(guī)劃就是采用反復(fù)進(jìn)行的局部優(yōu)化規(guī)劃代替一次性的全局優(yōu)化結(jié)果，充分利用傳感系統(tǒng)所能感測到的局部環(huán)境信息。在本項研究中，以周期的方式在滾動的每一步：(1)定義以當(dāng)前位置為中心的一個圓形區(qū)域為優(yōu)化窗口，以全局規(guī)劃的路徑點 為子目標(biāo)，由障礙物探測系統(tǒng)掃描此優(yōu)化窗口內(nèi)的障礙物，一旦出現(xiàn)原地圖沒有的障礙物，則修改原地圖。這一過程既是對全局先驗障礙物信息的修正，也是對動態(tài)、不確定障礙物信息的認(rèn)定；(2)由前面介紹的人工勢場法結(jié)合柵格法確定優(yōu)化窗口中的局部路徑，然后前進(jìn)一步，窗口向前滾動，產(chǎn)生新的優(yōu)化窗口，繼續(xù)步驟(1)。 5 仿真實驗 (a)顯示家庭服務(wù)機(jī)器人正確地避開了各種障礙物，從起始點(start)達(dá)到了目標(biāo)點(goal)。從圖5(b)可知，即使目標(biāo)點(goal)在障礙物附近，家庭服務(wù)機(jī)器人也能成功地到達(dá)目標(biāo)點。圖5(c)和(d)是滾動路徑規(guī)劃實驗結(jié)果。圖5(c)是用原始地圖規(guī)劃的路徑，家庭服務(wù)機(jī)器人開始不知道障礙物A存在。5(d)中家庭服務(wù)機(jī)器人很好地避開了未知障礙物A。 6 結(jié)論 勢場法由于算法簡單、勢場和勢場力的計算簡便，常用于實時路徑規(guī)劃系統(tǒng)。但勢場法存在著計算量大、局部最優(yōu)點。而柵格法存在環(huán)境分辨率與環(huán)境信息存儲量之間的矛盾。本項研究將兩者的優(yōu)點結(jié)合起來，既克服了勢場法的缺點，又能很好地規(guī)劃出路徑。本文提出的自主導(dǎo)航與路徑規(guī)劃方法即將用于我們開發(fā)的家庭服務(wù)機(jī)器人完成防盜監(jiān)測、安全檢查、家電控制、家務(wù)勞動、病況監(jiān)視、清潔衛(wèi)生等各項作業(yè)。 圖5 自主導(dǎo)航與路徑規(guī)劃仿真實驗結(jié)果 參考文獻(xiàn) [1] 馬駿騎．服務(wù)機(jī)器人[J]．昆明理工大學(xué)學(xué)報，1997 - 6，Vol．22，No．3，pp．32～36． [2] 陸新華，張桂林．室內(nèi)服務(wù)機(jī)器人導(dǎo)航方法研究[J]．機(jī)器人，2003 - 01，V01．25，No．1，pp．80-87． [3] 李群明，等．室內(nèi)自主移動機(jī)器人定位方法研究綜述[J]．機(jī)器人，2003 - 11，Vol．25，No．6． [4] 王醒策．基于勢場柵<